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ABSTRACT 


A manipulator and its control system (modeled after a Stanford design) 
is being developed at JPL as part of an artificial intelligence project. This 
development includes an analytical study of the control system software. 

This report presents a comparison of the computed torque method and the 
conventional position servo. No conclusion is made as to the preference of 
one system over the other, as it is dependent upon the application and the 
results of a sampled data analysis. 
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I. 


INTRODUCTION 


A manipulator and its control system (modeled after a Stanford design) 
is being developed at JPL as part of an Artificial Intelligence project. This 
development includes an analytical study of the control system software. The 
purpose of this report is to present the results of this study. 

The Stanford manipulator control system models the manipulator and its 
dynamics and computes the motor drive torque for each joint of the manipulator 
If the model were exact, the manipulator could be driven open-loop with no 
error. But because the model is not exact, rate and position feedback is used 
in addition to the computed drive torque. 

The manipulator operation is described from a control analysis viewpoint 
for the "Computed Torque" method in Section II and for a conventional position 
servo in Section III. The gains and output response for both systems are 
derived and discussed in detail. A comparison is made of the two control 
methods in Section IV. The Stanford gain values are used here for the "Com- 
puted Torque" method. But the final values may be different because the JPL 
application does not require as high turning rates, and the design is slightly 
different. 

II. COMPUTED TORQUE SYSTEM 

In the "Computed Torque" method the trajectory that the manipulator is 
to follow as a function of time is computed in the planning program. Each 
link angle (the angle of the manipulator joint) as a function of time, necessary 
to follow the desired trajectory, is also computed in the planning program. 

The drive motor torque required to achieve the link angle/time function is 
then computed based on a model of the manipulator hardware. The motor 
voltage/torque characteristic is also modeled and the computed torque is con- 
verted to applied motor voltage. This voltage is computed at a very high rate, 
applied to D/A converter, and finally to the motor input. 

If the manipulator and motor models were exact, the response would be 
exact, but this is not possible because of modeling inaccuracies and parameter 
variations. Rate and position feedback is therefore used to compute correction 
torques which are summed with the main driving torque. The result is a sam- 
pled data control system with performance dependent on the feedback gain value 
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TACHOMETER 



Fig. 1. Physical Configuration of Computed Torque Method Control Loop 







































1. 


Transfer Function Derivation 


The interconnection of the physical components and the computer subrou- 
tines is shown in Fig. 1, and the detailed flow diagram for control analysis is 
shown in Fig. 2. The latter does not contain the data samplers because this anal- 
ysis is for a linear continuous system. A subsequent sampled data analysis is 
required to determine the effect of the sampling frequency. The motor and gear 
train nonlinearities are modeled in the voltage torque characteristic which allows 
the linear analysis approach. 


The control loop configuration can be reduced to the configuration of Fig. 3, 
with the branch transfer functions defined as follows: 



Fig. 3. Computed Torque System Signal Flow Graph 
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G ? (s) = 1 


G g (s) = -1 


G 9 (s) 57.3 


G io (s) = - 1 


Gj j(s) = n 


From signal flow graph theory 


9 o G 1 G Z G 11 + G 6 G 3 G 2 G 11 + G 7 G 4 G 2 G 11 

6 i " 1 - G 5 G 10 G 3 G 2 - G 8 G 4 G 2 G 11 ' G 5 G 9 G 2 


( G i + G 6 G 3 +G 7 G 4 )G 11 

J-- ( g 5 g 10 g 3 + g 8 g 4 g 1 i+ g 9 c 5 ) 


r' , , r' / K\ r* 

J 77 — S + J K - 77 — S + J \ K + ) - 77 — 

K x V K t \ e s / K t 

R, , . R . / K—A R^, 

T M 2 , . T ' T , M , T 1 I r/ T 1 M 

J 77 — s + s + J K 77 — s + J IK + I 77 — 

K B v K \ e s ) K 


R* •, . . R w / K t \ 

J 77 — s + J,. 77 — K s + J 77 — l K + — I 

K t o k t v K t \ e s J 

R, , R, , R».r / K T 

T M 2, t i M _ , T ' M| t ^ I 

J 77 — s + J -77 — K S + J — IK H 

K t K t v K T \ e s 


If J - J, R m /K t - R m /K t . 


JPL Technical Memorandum 33-601 


5 


1 


(3) 


e S 3 + K S 2 + K s + K t 

0 , . v e I 

Q ( s ) ~ "3 7 
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Each of the individual branch transfer functions (G^ — ♦ G ^ ) will now be 
described in detail. 


G^: Drive motor and load. 

The voltage applied to the motor is 


V = E + i_. R_, 
a MM 


(4) 


where 


E = 


M 


R 


M 


backe.m. f. voltage 
motor current 
motor resistance 


(volts) 

(DC amps) 
(ohms ) 


The motor torque (referred to motor shaft) is a function of the current and the 
torque constant, K^, for a particular motor. 


t m k t x m 


(5) 


where 


K^, = motor torque constant 


(oz-in. /amp) 


The back e.m. f. is a function of another constant for the particular motor. 


E = K B 6 M 


( 6 ) 
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where 


K d = motor back e. m. f. constant 

XJ 


0, , = motor shaft rotation rate 
M 


volts 


) 


( rad/ sec 
(rad/sec) 


Substituting for E and i in Eq. (4) 


R Vf 

V = 0. , + t-¥±- r 

a B M M 


(7) 


The motor torque will produce an angular acceleration of the motor shaft. 


t = J 0 
M M 


( 8 ) 


where 


J = J. , + n J T 
M L 


(oz-in. /rad/sec^ = oz-in. -sec^) 


(9) 


This total inertia is referred to the output by dividing by n 


J o = -T J 
n 


( 10 ) 


J. 


M 


motor rotor inertia 
load inertia 


(oz-in. - sec ) 


(oz-in. - sec ) 


n l 

n = — - ratio of motor gear teeth to load gear teeth 
n 2 


0^ = motor shaft angular acceleration (rad/sec ) 


JPL Technical Memorandum 33-601 


7 



As indicated above, the load inertia is referred to the motor shaft by 
multiplying by the gear ratio squared. This is simply derived by using the 
conservation of energy principle. 



LM 



I J L 



where 


J T „ , = load inertia referred to motor shaft 
LM 

0 d = load or output rotation rate 


Substituting 0 Q = n 0 results in 

t 2 r 

J LM = n J L 


(ID 


( 12 ) 


Now, to derive the motor transfer function, substitute from (8) into (7). 


V 

a 


K B % + K 


M 


J 0 


M 


(13) 


Taking the Laplace transform with I. C. = 0 


G 2 (s) 


6 M< S > 

V a (s) 


s 



57.3 


R 


+ 


M 


K r 



(14) 


The motor transfer function is in terms of radians output, but the pro- 
gram as presently defined uses degrees. Therefore, the 57.3 factor is intro- 
duced in the numerator. 

G^: Computed torque 

The driving torque (not including error torques) is computed in Gj 
from known motor and load parameters and then changed to applied motor 
voltage. For this analysis the gravity torque shown in fig. 2 is not 


8 


JPL Technical Memorandum 33-601 



included in G . This is done because it can be handled as a known disturbance 
i i 

input which is then cancelled by the computed gravity torque, t . As shown in 

§ 

Fig. 2 the gravity torque t is transferred from the output to the input for 
analysis purposes. It then has to be reduced by the gear ratio, n. The cancel- 
lation can be quite accurate except for the effect of an unknown weight being 
lifted by the manipulator, although the object weight can be determined from 
the error signal and then included in the computed gravity torque. This will 
be discussed under disturbance torque. 

With the gravity loop eliminated, the remaining branch of computes 

the required motor torque. From known manipulator parameters and 0^(t), 

the changing inertia j'(t) can be computed. Referring to Eq. (8), it is seen 

that the torque is proportional to the angular acceleration and the total inertia 

referred to the motor shaft. (referred to output) is computed in the pro- 

2 

gram, therefore the n factor is needed. Angular acceleration can be computed 

2 

because 0^(t) is analytic (third degree polynomial) and is represented by s . 

The 1/n factor is needed because 0^ refers to the manipulator joint angle, but 
we are now referencing to the motor input. Therefore, 0^ (used to compute 
the motor torque) must be divided by the gear ratio. The final operation 
here is to change this required torque to applied motor voltage. This could 
be done as shown by using a constant R^/K^ (volts/oz-in.) which is the 
torque to voltage conversion constant for a particular motor neglecting 
motor friction and reduction gear losses. With only coulomb friction 
torque present (given in motor specs), the constant slope voltage torque 
curve is displaced up for plus 0^ by the voltage to overcome friction and 
down for minus 0^.. But with the reduction gear, the characteristics are not 
so simple. An approximation to the curves are shown in Fig. 4. They will 
be determined from lab tests by measuring the output torque, keeping 0^ 
constant and varying the applied voltage (the ordinate, V does not include the 
back e.m. f. voltage). The solid lines are theoretical for no gear reduction 
and the dotted lines connect data points from lab data. Note that there are 
three different slopes or torque constants (K.,,,, K. ,~). K A ... differs 

from the theoretical value (Rj^/Kj) by the constant p which is the additional 
voltage required due to loss in the gear transmission. For +0j^j and + T 0 » p is 
plus because the loss is opposing the desired output t q , but for - t q the loss 
is aiding. The area covered by K.^.^ is somewhat nonlinear and the value 


JPL Technical Memorandum 33-601 


9 



V M (V OLTS) 



Fig. 4. Typical Drive Motor Voltage - Torque Characteristic 

(referring to +0^) is an approximation joining the ordinate cross point from 
Kmi and a. point with an ordinate -V^ on The point does not seem to have 

any theoretical relationship but was selected arbitrarily as coinciding with lab 
data. The final result of all this is that only three torque constants are needed 
(K^., p, along with the sign of 0^ and the ordinate breakpoints for t q , 

to convert this torque to voltage. Lab tests will be performed to obtain this 
characteristic. 

From Eq. 4 under G ^ the applied motor voltage is 


V 

a 


E + 


M 



E + V 


M 


(15) 


With Vjyj now computed the back e.m.f. (E) has to be computed to get V^. This 
is done in using the motor rate 0^. from the tachometer. 
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G^,Gj-,Gjq: Rate error 

The motor output rate is obtained from the tachometer (Gj.) mounted on 
the motor shaft. The desired link angular rate (6h) is computed in the planning 
program and is multiplied by 1/n to reference it to the motor. The two are 
compared to indicate the rate error. The unity gain, G^q is only for transfer 
function derivation purposes to separate the rate error from motor rate which 
is used in G . The tachometer output is in volts, and an A/D converter is 

7 

required so the computer can interrogate the motor rate. The interrogation 
of 0^ is at some finite rate, thus, we have a sampled data system. 

G^: Rate error feedback gain 

The rate error is converted to radians /sec and multiplied by J to 

remove this changing parameter from the system response characteristic. 

If it remained, the damping ratio and natural frequency (reducing to a second 

order system) would change with j' . The system damping ratio is now a 

function of the constant, K and of K . 

v e 

G ,G 0 : Position error 
( o 

The manipulator link rotation angle (0 Q ) is obtained from a potentiometer 
mounted on the link, and the desired link angle (0^) is available from the planning 
program. The two are compared to indicate the position error which is later 
multiplied by 1/n to reference it to the motor. 0 Q is in volts, thus, an A/D 
converter is required. As with 0^. above, the interrogation is at some finite 
rate, which makes the system a sampled data system which can be analyzed 
as such using Z transform analysis methods. Any small delay time for reading 
in 0 Q and 0^. can be incorporated in the analysis also. 

G^: Position error and integral feedback gains 

The position error is converted^to radians and multiplied by J* as with 
G^, but here it is to keep the system undamped natural frequency constant. 

The integral gain (K^) which will be discussed in Section II-4 is also now a 
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constant. It should be noted that the integration (K^/s) is done numerically in 
the computer as: 

(1) Initialize t = 0 


T 

Ii 


x H - 

Ii - 1 57. 3n 


K I At0 £ 


where is the computed torque for the present computation cycle 
At is the computation cycle time 
0 £ is the position error in degrees 


( 16 ) 


G n : Motor back e. m. f. voltage 

7 

In Fig. 2 Gj, G^ and G^ do not include the voltage -torque conversion 



because in the computer program, the three outputs are summed and only one 
conversion is necessary. In the analysis the factor is included in each only for 
simplicity, but the total output voltage is V^(s). 

From the G^ derivation, the applied motor voltage is 


V 

a 


+ L R 
M M 


E + V 


M 


Thus, the back e.m. f. voltage, E has to be computed. This is done in G^ 
in which the known motor constant K is used with the tachometer motor 

ID 

rate. 


E = K 0 
B o 


1Z 
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Response to Input Forcing Functions 


As shown in Eq. ( 3 ) the output is identical to the input if the inertia, 

t 

J is computed correctly and if the voltage torque curve is exact, 

i. e. , 


i 



R 

K 


M 

T 


Therefore, the output or link movement 0 Q (t) exactly follows the input, 0^(t) 
which was computed in the planning program. But practically, errors due to 
approximations in modeling and unknown system nonlinearities prevent this 
ideal response, consequently the error feedback loops were included. 

It is obvious that if the motor torque is computed correctly, the output 
should respond correctly in an open loop manner and there would always be zero 
error. And the previous derivation of the system transfer function would be 
unnecessary. However, analyzing the response to disturbance torques or 
unknown gravity torques does require a transfer function. Also, it is possible 
to insert an inertia error, Aj' and determine the response error. Additional 
transfer functions are derived in the following sections. 


3. Transfer Function for Feedback Position and Rate Errors 

The two feedback transducers involved in each link control loop are a 
potentiometer and a tachometer which could have bias or null errors. The 
transfer functions for these errors can be derived easily from the system 
transfer function derived in Section H-l. 
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Position Feedback Null Error: 
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ForA0.(s) = A0./s 
1 1 

K (s + K t /K ) A 6 . 
a , \ e_ 1 e' l 

^ s ^ " 3 Z 

s(s + K s + K s + K t ) 
v e I 

The steady state error is 

0 o (t) = s 0 o (s) = A0. 

t -* a) S — > 0 

with Kj = 0 

K AG. 

0 (s) = ? ^ 

' s(s^ + K s + K ) 

v e 

0 o (t) = A0. 

t -*• ® 


( 20 ) 


( 21 ) 


( 22 ) 


(23) 


Thus, the steady state error is the same with or without the integral gain. The 
second order transfer function can be in the form 


V s > 

A0. (s) 

l 


1 

2 , _ r ’ 2 
s + 2c oa s + u 
n n 


(24) 


where L, is the damping ratio and the undamped natural frequency. The step 
function response for £, = 1 is shown in Fig. 6. 

The response with 4 0 is altered very little if the resultant additional 
pole and zero are close together. Thus, the ratio of K^/K^ is the determining 
factor. It should be noted that the above is the system response if the link 
position is at some different position than 0^ which comes from the planning 
program. 
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Fig. 6. Step Function Response for Unity Damping Ratio 


Rate feedback error : 

The signal flow diagram for a rate null error is 



Fig. 7. Signal Flow Diagram for Rate Null Error 
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ForR M /K T = R M /K T' J ’ = J 


V s > 

A V (s) 


- K v + r77 k b 1 s 
M 

s 3 + K s 2 + K s + K t 
v el 


( 27 ) 


For a step input error, A0^(s) = A0^/s 


V s > 


nl - K v + ^ K Bj A V 

M 

s 3 + K s 2 + K s + K t 
v el 


(28) 


for which 


e G (t) = o 

t —* CO 


If K = 0 


0 o (s) 


n V * K V + R K B I A6 M 
M 

s ( s 2 + K s + K ) 
v e 


(29) 


for which 
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- K + w 
v R 
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e G (t) 
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t— *00 


(30) 
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Thus, there is a steady state error if the integral feedback gain is zero. The 
time required to bring this error to zero depends on the magnitude of K^. 

4. Transfer Function for a Disturbance Torque 

A disturbance torque on the output can be expressed as a motor input 
for analysis purposes. It is then treated as a normal input but must be 
reduced by the gear ratio, n (n < 1). An uncompensated gravity torque such 
as a load picked up by the manipulator is such a disturbance torque. The 
signal flow diagram for a disturbance torque is shown in Fig. 8. 



Fig. 8. Signal Flow Diagram for a Disturbance Torque 


where = R M /K T 
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(32) 
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Since 


dM 


= n t 


do 


V s > 

T do (8) 


K _ , 2 R M 

57.3 n — — s 

m 


T R M 3 ' 

J — s + J 

K T 


R 


R. , -> , R > , 

M 2 . T ' M T , , T ' 

-rz — K s + J rr K s + J -rr 
K_ v K m e K 


M 


K t 


( 34 ) 


For a step input, T ( j 0 ( s ) = /s 


Oq^) 


t ► 00 


with Kj = 0 


0 o ( t ) 


t— *- oo 


K - , 2 R M 

57. 3 n yr T, 

K t do 

i 

l -^n/r 

J ~ - K 

e 


(35) 


The torque conversion factor was left in because in this case the R,,,/K„ does 

, M T 

not cancel out if the computed value, R^./K^, (from the curves) is not equal to 
the real value, R /K . If they are equal. 


t— ►oo 


57.3 n 2 r, 
do 

j’k 

e 


(36) 


where iVj is the disturbance torque in oz-in. , and 0 Q is in degrees. 

As might be expected, the steady state error is not a function of the 

i 

changing inertia (J), but with the J multiplier the error is reduced by the 

i 

resultant gain, J K . 

& e 
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Feedback Gain Values and Resultant Response 

The purpose of this section is to insert gain values in the various transfer 
functions and steady state error expressions to indicate realistic output error 
values. The gains used are the Stanford values but will be converted to 
eliminate the At (jiffy)' 1 ' element. This is necessary to use them in the transfer 
functions . 

First, we will look at the characteristic equation. 

s 3 + K s 2 + K s + K t = 0 (37) 

v e I 

If Kj. = 0, we have 

s 2 + Ks+K =0 (38) 

v e ' 

which is a second order system and can be expressed as 

s 2 + 21,00 s + oo 2 = 0 (39) 

in which 

£ = the system damping ratio 
oo n = the system undamped natural frequency (rad/sec) 

Common practice is to select £,= 0. 7 and oo^ as high as practical to 
increase the response or tightness of the servo loop. Stanford has selected 
£ = 1 which is reasonable since the overshoot for a step input is then reduced 
from 7% (I, = 0. 7) to zero. Doing this we have 

2oo = K ; 

n v 

oo 2 = K 
n e 

‘'The term "jiffy" refers to the 1/60 second sampling interval used at Stanford. 
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or 



Now, selection of K or K determines to . Remember from Fig. 6 that the 

e v n e 

response has reached its final value (practically speaking) at t = 7 = 7/v K^. 

This is all very nice, but as shown above the characteristic with 
Kj / 0 is third order. Fortunately, (depending on the value of K^) the system 
can still be considered second order to get a measure of the system transient 
response. This will be elaborated upon further. 

The gains used by Stanford for joint 1 are 


K = 0.038 
e 

K = 0. 39 (41) 

v 

Kj = 0.005 

These have the time element of 1/60 sec in them, therefore to eliminate this, 

K = 0. 39 x 60 = 24. 4 
v 

K e = 0. 038 x 60 2 = 132 . (42) 

Kj = 0. 005 x 60 3 = 1080 

Substituting these values in the transfer function for a step displacement from 

Eq. 19 


e o (s) 

A6.(s) 

i 


132(s + 8) 

s 3 + 24s 2 + 132s + 1080 


(43) 
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factoring (for Stanford gains) 


°o^ b; 132(s + 8) 

A0 i (s) (s + 20. 2)(s 2 + 3. 9s + 52) 


K = 1080 
i = 0. 27 


u> 

n 


7. 2 


If Kj is doubled 


9 o (s) _ 132(s + 16. 3) 

A0 i (s) (s + 22.4)(s 2 + 1. 6s + 96) 


K = 2160 

4=0. 08 

oj =9.8 


for Kj = 0 


0 O (B) 

A0.(s) 

l 


K 

e 

s 2 + 24.4s + 132 


/ K I = 0 

I ; = 1.0 

( w = 11.5 

' n 


(44) 


(45) 


(46) 


As Kj increases from 0— - 1080 the transient response is altered very- 
little (although) the steady state error will now go to zero over a longer time 
than the initial transient). At = 1080 the zero and pole added are not too 
close together, the £, is quite low, but the pole has a stabilizing effect to cancel 
the destabilizing effect of the zero and the decreased 1,. The result is a respons 
similar to when = 0. But as approaches 2160, the pole and zero approach 
each other and can be cancelled leaving just a second order system with very 
low damping. As increases further the system becomes marginally stable, 
i. e. , C, = 0. Thus cannot be increased much beyond 1000. 

For stability purposes has to be controlled as above, but to eliminate 
rate and position null errors and to reduce the output from a torque disturbance 
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to zero as rapidly as possible, Kj should be large as feasible. The restriction 
for at least marginal stability is that 

K < K K (47) 

I v e ' ' 


This is derived from the characteristic equation in Eq. (19). Let K T = K K in 

I v e 

s 3 + K s 2 + K s + K T = 0 
v el 

which then factors into 

(s + K ) (s 2 + K ) = 0 
v e 

This indicates that the two complex roots are on the imaginary axis of the 
complex s plane, therefore the system is marginally stable. 


If and are selected on the basis of considering only the second order 
response for £ = 1 (Eq. 40), then 


K 


< 

I - 



(48) 


The above restriction on applies as well to a torque disturbance since the 
characteristic equation (Eq. 34) is the same. It is of some interest to consider 
the steady state error when = 0. 


57. 3 n t 


G o (*) 


do 


(49) 


J K 


t — co e 

In all the previous discussion the value of j' did not matter since it cancels 

out if all gains and operations are as shown in Fig. 2. Here we have assumed 

that J not J Q is used as the gain multiplier, otherwise the n factors would be 

different. Consequently, the above error is a function of J ' , the computed 

2 ' 

inertia referred to the motor. This is of course n J~. 


A value of J Q for the first link from the Stanford arm is derived as 


follows (the prime denoting computed is dropped). 


Total inertia: 

J q = 698,000 

oz -in. 

ji ff y 

Motor inertia: 

J., = 285,000 

Mo 

oz -in. 

jiffy 2 

Load inertia: 

J T = 413, 000 
Lo 

oz -in. 

jiffy 2 
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2 2 
To eliminate the jiffy time element requires dividing by 60 


J T = 115 
Lo 


oz -in. -sec 


J =79 
Mo 


oz-in.-sec 


The total inertia referred to the motor is 


J = n (J - + J T ) 

' Mo Lo 


(50) 


= ^-(79 + 115) 

( 120 ) 

= 0.005 + 0,008 = 0.013 oz-in. sec^ 

The value of n for the JPL arm (link 1) is 100 and the inertia values will be 
larger. 

Substituting values in (49) 

57.3 t , 

©o (t) = ? — = 0. 002 t (51) 

t — co (120) (0. 013)(132) 

If a force of 16 oz is applied with a lever arm of 30 inches, the resulting output 
angular error is 0. 96 degrees. Thus if this magnitude of error cannot be 

i 

tolerated, would have to be increased, keeping in mind that J is a variable. 
The other alternative is to introduce the integral gain, which would reduce 
the error to zero. 

III. CONVENTIONAL POSITION SERVO 

The positional servo described here uses the same sensors or trans- 
ducers as the computed torque system but feeds this information directly 
to a summing amplifier which drives the motor, rather than to the computer. 


24 


JPL Technical Memorandum 33-601 



Position, rate and integral feedback are used. A linear analysis is used 
which ignores the nonlinearity of the motor and gear train. A further analysis 
using nonlinear techniques is required to determine if and what type of com- 
pensation is needed to get the required performance despite these nonlinearities. 

1 . Transfer Function Derivation 

The components in a control loop for one manipulator link are shown in 
Fig. 9 and the form for analysis in Fig. 10. 

The forward gain function is 



The feedback gain function is 



Fig. 9. Physical Configuration of a Control Loop 
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e o( s ) 

e.(s) 


/ R 
nK K J „ 
a e/ K 


M 


0 (K d + K K ) n K K 
2 ' B a v , a e 

S + S + 


R 


M 


K r 


R 


M 


K r 


where 


w = 
n 


/ R 

n K a K e/ J K 


1/2 


M 


& = 


K + K K 
B a v 


R 


1/2 


2 nK K J 


M 


a e K r 


selecting £, = 1 and solving for and 


( 55 ) 


(56) 


(57) 


- K K + 2nK J _ _ 
B v e K 


M 


±2 


I R 

nK J jy 
e K 


M 


( R 

nK 

e K^ 


K„K 
B v j 


K 


(58) 


K 


v 


K 

v 


- k b + 2 - 


R 

nK K J 
a e K 


M 


K 

a 


(59) 


In the above equations, all parameters except K g are known, and a maximum 
value for this gain will be developed in Section 5, 

From Eqs. 27, 47 and 54 the stability criterion with K^ 4 0 is 


nK K K t K (K d + K K )(nK + K K T ) 
a e I a B v a e v I 



( 60 ) 


JPL Technical Memorandum 33-601 


27 


or 


K I 5 


nK (K„ + K K ) 
e B a v 


R 


n J 


M 


„ K - K (K + K K ) 
K m e v' B a v 


Generally the second denominator term is very small and 


K I £ 


K„ + K K 
B a v 


R 

K, 


M 


(61) 


(62) 


This criterion only specifies a maximum for conditional stability. Of 
course K and did not have to be computed from Eqs. 58 and 59 for £, = 1 
but that is a preferable way. The point to consider is the proper value of 
Kj << Kj max to produce a transient response similar to that expected from 
the second order equation. 

3. Response to Input Forcing Functions 

The response to an input from the planning program, unlike the com- 
puted torque case, depends entirely on the feedback gains. The input is 0^(t) 
and the ability of 0 Q (t) to follow depends on the amplification of the resultant 
error signal which then drives the motor. A typical input function is shown 
in Fig. 11. As indicated the JPL requirement is for a slower response, 
at least for the present. 

A measure of the error in 0 (t) can be obtained by approximating the 
input function with a sinusoid as shown, and then finding the frequency response 
to this input frequency, w. 

Substituting ju> for s in Eq. (54). 


e o<j“> 

e^jw) 


nK K (ju> + K t ) 
a e J I 


nK K K T - (K +K K )u + j 

a e I ' r ^ ,r' j 


B 


a v 


R-. , o 

K (nK + K K )oj - u 

a e v I K-, 


(63) 
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+ 50 ° 


+ 50 ° 




Fig. 11, Typical Input Function, 0^(t) 


The magnitude of this function is 


6 nU“) 


e i (jw) 


° K , K e(“ 2 + K I ) 


[ 


nK K K t 
a e I 


(K B + K a K v )w 


+ 


R 

K (nK + K K )u> - ^ 
a e v I K 


M _ 3 
J co 


(64) 


For f < 1 cps and for anticipated values of gains, this function is so close to 
unity that it can be considered as such, and only the phase angle, 4> need be 
considered. 


Ry -J 

K (nK + K K t )u> - tt— J oj 
- 1 _i* a e v I K_ 

= tan ( oj/Kj) - tan | j 

\nK K K T - (K + K K )w 
* a e I e a. v 


(65) 
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0. 013 


For f = 0.2 (oo = 1.356), = 0.001, = 200, Kg = 0.05, J 

R^./Kg = 0.123, which are nominal values, this reduces to 


<f> = tan 1 (oo/K^) - tan * 



/ K K T \ 

oo 

(‘-ar 1 

k7 

L I 

\ e / . 


4> = tan 


oo K Kl" 
v I 


nK 


( K i 2 + “ 2 ) 


+ to K K t 
v I 


for K Z » co Z (K « 10) 


<)> = tan 


. . - oci K K 

1 I v I 


nK K t + oo K 
el v 


For n = 0. 01, K = 7, K T = 10, K =0. 001, oo = 1. 356, which are nominal 
e I v 

values, 


$ = - tan 


i/!fv 

\ nK 


(rad) 


( 66 ) 


This is the phase lag in © Q (t) for a sinusoidal input, 0^(t) 
error in 0 Q (t) can be expressed as 


-0 sin cot. The 
P 


A0 o (t) = - 0 p sin oot + 0^ sin (oot + <f>), <j> is neg. 


= 0^ [ sin oot (cos 4> - l) + cosoot sin 4> ] 


(67) 


For small cj> 


A0 Q (t) = 0 <j> cos oot 

P 


( 68 ) 
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where 


0p is the peak angular sinusoidal rotation 
<|> is the phase lag in radians from Eq. (66). 


Another way of determining the response error is to assume a ramp 


input for 0,.(t). 


0 (t) = kt 


(69) 


0 i( s) = ~ 
s 


From Eq. (55) for £, = 1, we have 


0 o (s) 

e.(s) 


i 


s" 2 . , 

— - + — s + 1 
2 oj 
w n 

n 


0 O ( S ) 

s0.(s) 


(70) 


Therefore 


0 (s) = 
o v 


(k") 


(71) 


0 o (t) - k 


1 - (1 + jw t) e 
n 


-cj t 
n 


(72) 
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The output error is 


A6 0 (t) = 





dt 



( 73 ) 


where can be computed from the system parameters, and k is the ramp slope 
in degrees or radians per second. 


4. Transfer Function for a Disturbance Torque 

An output disturbance torque, r can be transferred to the motor input 
by multiplying it by the gear ratio. 


T dM ‘ n T do 


(74) 


Therefore, applying at the motor input 


G(s) = 


n 


( K + r m 

s + — — s 


B K t 


/ K K 

H(s) = K 1 K + — s + — 
a \ e n s 


R 


M 


e o(s) K t 


n G (s) 


Tj (s) 1 + G(s)H(s) 

do 


R 


K 


M 2 
n s 


— ^ Js 3 + (K + K K )s 2 + nK K s + nK K T 
B a v a e a I 


(75) 


(76) 


(77) 
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For a step disturbance torque, the output error is 


0 o (s) 


R M 2 

K t T do n 


R 

-rM Js 3 + (K-, + K K )s 2 + nK K s + nK K T 
K m B a v a e a I 


( 78 ) 


The steady state output error is 


e 0 (t) = s e 0 (s) = o 

t — *-co s —►0 


5. Gain Values and Resultant Response 

The determination of gains for this system is more complicated than for 
the computed torque system since more variables are involved and physical 
limitations come into play. Selecting gains based on a second order response 
as mentioned before means arbitrarily letting the damping ratio, £ = 1, and 
selecting'an arbitrary undamped natural frequency, w n * The latter can be done 
by considering the response desired as shown in Fig. 6. 

The equations for the gains ( £, = 1 ) are 



K = J 
a 



2 


u> 


n 

nK 


e 


(80) 


Nominal 

values 

of the above parameters are 

J 

= 0. 013 

, . 2 > 
(oz-in. sec ) 

V k t 

= 0. 123 

(v/oz-in. ) 

k b 

= 0. 05 

( v/ rad/ sec) 

n 

= 0.01 

(N^/N^) gear ratio 


(81) 
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The value of K g is dependent on the angular range which is ±180° and the supply 
voltage = 24. Thus, the pot sensitivity is ±12/ir (volts /rad). Adding some 
amplification with the same D.C. voltage supply can increase this to±24/-rr. A 
value of = 7 will be used here. Inserting all these values in (79) and (80). 

K = / 2 - — \ (82) 

V CO l tO / 

n \ n / 

K = 0. 023 co 2 
a n 


Selecting co^ = 100 for a very fast step response (Fig. 6). 

K = 0.0012 
v 

K = 230 
a 


(83) 


Now Kj has to be selected 


K + K K 

K t < B a V = 204 


M 


K, 


(84) 


Obviously, to get a response approaching 1, = 1, has to be considerably 
less than this maximum value. Selecting K^. = 10, the system transfer function 
is : 


6 o (s) _ 10, 062(s 4 10) 

9 i (s) s 3 + 203. 7s 2 + 11, 787s + 100, 625 

Factoring 

6 o (s) = 10, 062(s + 10) 

6 i (s) (s + 10. 2)(s 2 + 193. 5s + 9813) 


(85) 
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Obviously, the pole and zero essentially cancel and the response is second 
order with 


W n = 99 

i = 0. 98 


( 86 ) 


The high values of K and and the relatively low has left the response 
the same as without Kj. This is fine except that high amplifier gains create 
a noise problem. The transient response is much better than needed, but 
to control the error for a very rapidly changing input forcing function such as 
shown in Fig. 11, requires a high gain. From the sinusoidal input error func- 
tion (Eq. 68) and Eq. 66, 


A 0 o (t) = 0 p 


<j> cos tot 


= 0 tan 
P 



(87) 


Substituting the previously given parameter values 

A0 Q (t) = 0^ tan *(0.017 to) cos tot (88) 

For 0 p = 50 deg, to = 1. 356 

A0^ p = 50(0. 023) = 1. 15 degrees (89) 

For to = 6. 28 which is a nominal input for the computed torque system at 
Stanford, this error increases to 5 degrees. Thus, it is obvious that, if the 
system is to compete with the Stanford computed torque system, the gains 
would have to be increased which is feasible. 
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A check on the above response error is to use error Eq. (73) for a ramp 
input. For the sinusoid used, the maximum 0^ is about 60 deg/sec. The 
natural frequency from Eq. (86) is 100 rad/sec. 


A0 o (t) = k 



-w t \ 


-U) t 

2 ( 

i n 


n 

zr \ 

. n 

1 - e 

- t 

e 


= 60 


2 ( 

, -100t) 

.100 V 

1 - e / 


)...■»] 


(90) 


Thus, for t > 0. 1 seconds, the error equation reduces to 


A0 o = = 1. 2 degrees (91) 

w n 

which compares well with the previous value of 1. 15 degrees from (89). 


6. Effect of Changing System Inertia 

The inertia changes as the manipulator moves links which extend or 
retract the arm. This is of no consequence for the computed torque system 
since it is computed and the computed value is used to eliminate this parameter 
from the system response. This is essentially computing a variable feedback 
gain. For the conventional system the natural frequency and damping are 


w 

n 


( nK K 
y a e 



1/2 


(92) 


C, = 


K-r, + K K 
B a v 


R 


TJT 


2 nK K J 


M 


a e K r 


36 


JPL Technical Memorandum 33-601 



As discussed, this is the case if the gains are as shown earlier which 
essentially reduces the system to second order. 

The inertias of the JPL arm are not yet known. They will be larger 

than the Stanford values which have been used in this report, but using Stanford 

values is most likely sufficient for this discussion. Supplied data indicates 

that the inertia value can about double for link No. 1. This means u> and £, are 
n 

decreased by \fl ~ which would not change the transient performance or decrease 
the stability any significant amount. This is even less significant for other 
links, except when a large inertia object is being manipulated. 

IV. COMPARISON OF THE TWO DRIVE METHODS 

The following paragraphs are a summary of the more important character- 
istics of the computed torque (CT) and conventional position servo (CS) systems. 
However, no final conclusion is made as to which system should be used because 
this depends on the particular application and on the results of a sampled data 
analysis. 

1) Input Forcing Functions 

CT: There is theoretically no output position error if the torque is 

computed correctly to produce the response computed in the plan- 
ning program. This assumes the inertias are computed correctly. 
The advantage here is that very fast motions can be accomplished 
without depending on a feedback error. 

CS: There is always a transient error which subsides to zero as 

the motion rate decreases to zero. This error is minimized by 
selecting the largest possible forward and feedback gains. 

2) Disturbance Torque 

CT: An unknown external force on the manipulator is a disturbance 
torque. Gravity torques are computed and compensated along with 
reaction torques from rotations in other non-perpendicular links. 
Lifting an object produces an unknown torque which results in an 
angular position error. The integral gain term then zeros this 
position error due to any unknown torque. The resulting output 
of the integral gain term indicates the torque value and thus the 
weight of the object. 
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CS: The feedback error signal from the integrating amplifier must 

compensate for all disturbance torques including gravity and 
reactions from other links. This is not too serious a problem with 
high enough gains. The reaction torques are only about 5% of the 
applied torque, and the gravity torques would not pose any problem 
since the output error is driven to zero by the integral term. Very 
fast motions with a large changing gravity and reaction torque 
would produce an error dependent on the gain values. 

Gains 

CT: The feedback gains (link 1) are such to produce a damping ratio 

(£,) of 1 and an undamped natural frequency of about 10. This is 
not a very tight loop, but the only reason for possibly increasing 
u> n is for better response to disturbance torques, although the 
integral term eventually reduces the error to zero. There appears 
to be no reason for not making the gains for all the links the same 
or certainly not much different. These gains and their use take 
place in the computer, therefore can be easily changed with no 
effect on the hardware. 

CS: The gains are considerably higher to produce anu n = 100 

rather than 10. • This does not appear to be a problem as far as the 
hardware is concerned. The gains here are constant but the 
inertia changes which then changes u> n and £, . This maximum change 
factor is only about l/\/~2"{for the manipulator inertia alone). Changing 
gains means a physical adjustment on the amplifiers. A set of 
gains would have to be derived for each link since the inertias and 
motor torque constants are different. 

Nonlinearities 

CT: The nonlinearities in the drive motor, mainly the coulomb 

friction torque, and the gear train nonlinearity effects are all handled 
easily in the computed torque program. This is a distinct advantage 
of this method, assuming the nonlinearities can be modeled accu- 
rately. This does, of course, involve precise lab testing. 
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CS: The linear analysis presented in this memo does not consider 

these nonlinearities. To be sure of proper performance a 
nonlinear analysis is required and compensation introduced. This 
can probably be done with some limitation on performance. 

5) Sampling and Delay 

CT: The feedback position and rate are sampled at some rate 

depending on the time span of the fastest input function from the 
planning program. The input to the drive motor amplifier is also 
sampled at the same rate. The drive torque is computed which 
takes a finite time. Thus, the system is sampled data with a 
delay. If a longer time span is used for the JPL system (5— *-10 
seconds for a large angular movement) the sampled time is much 
greater than the computation delay, and the latter can be ignored. 
But a sampled data analysis with one period delay in the feedback 
data is probably needed. 

CS: Since the feedback takes place external to the computer, the 
system is continuous except for sampling of the input driving 
function from the planning program. Some consideration to this 
sampling rate is all that is required beyond the linear analysis, 
complemented by the nonlinear analysis. 

6) Complexity 

CT: Obviously, the large program for computing the drive torque 
is the negative aspect of this method. But if the effort of developing 
the program, debugging it, and the computation time and computer 
capacity are acceptable, considering the increased performance 
over a conventional servo, the system appears very attractive. 

Two A/D converters per link are required to get the. position and 
rate information to the computer. A D/A converter provides the 
motor drive signal. Another factor is determination of very 
accurate inertia data and motor torque -voltage characteristics 
for essentially modeling the manipulator in the computed torque 
program. 
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CS: No torque program is needed, therefore, only approximate 

information on inertias is needed. Nonlinearities need to be 
known approximately so that the compensation and performance can 
be determined. The two A/D converters for feedback are not 
required. One or two additional amplifiers are needed per link. 

7) Data Transfer 

CT: Three data transfers per link are required. The rate of this 

transfer depends on how fast the arm is required to move and the 
desired accuracy. For a 5 second full angular movement of 180 
degrees, a sampling rate of 20 to 30 per second is probably sufficient, 
but a detailed study is desirable using the results of this analysis 
and some sampled data analysis. At each sampling 3 words per 
link are transferred. 

CS: Only the input function is transferred every sampling interval. 

This can probably be at the rate mentioned above, although here it 
is not so critical because the servo loop does all the control rather 
than the input. 

8) Additional Analysis Required 

CT: A sampled data analysis with one sampling interval delay plus 
a computation delay, although the computation delay is probably 
negligible. 

CS: A Nonlinear analysis considering the motor friction torque 
and gear train effects. 
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APPENDIX A 


USE OF A CURRENT SOURCE FOR THE MOTOR DRIVE 

The analysis in the body of this report assumes a voltage gain amplifier 
prior to the drive motor for both the computed torque system and the conventional 
position servo. A disadvantage of the voltage source is that a change in motor 
input resistance will affect system performance, whereas with a current 
source, the input current and thus torque is not affected. The effect of this 
resistance change on system performance is determined by examining the 
relevant equations in this report. 

The first concern is with stability. This is determined by investigating 

the characteristic equation which is derived from (2) by assuming J = J* and 

that the torque constant (K^,) remains constant as the motor resistance (R ) 

varies from the nominal value (R, ,). 

M 

— — s 3 + K S i 2 + K s + K. = 0 (A- 1 ) 

R' v el 

M 

i 

A ratio change in R^/R^ from 1 to 1.2 which is the maximum anticipated 
change in R,, results in 

1.2 s + 24 s 2 + 132 s + 1080 = 0 (A-2) 


or 


3 

s 


+ 20 S 2 + 110 s + 900 


0 


Kj .< 2200. 

Whereas with R. ,/R, . = 1.0 
M M 

K < 3220. 
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Factoring (A- 1 ) 


(s + I6.6)(s 2 + 3.4 s + 54.6) = 0 (A-3) 

The two complex roots have =7.3 and £ = 0. 23 which compares to 
w =7.2 and £ = 0. 27 for no change in R,, , (i. e. , R. ,/R ' , = 1 ). Thus, the 
change in the system stability due to a 20% change in motor resistance, (and 
using a voltage drive) is very small. This effect can be reduced further by 
using a value of R^. midway between the 20% variation. This actually means 
altering the voltage-torque characteristic slightly, assuming it is taken at the 
low end of the resistance change. 

The effect of a change in R^ is much the same for a conventional system 
whose characteristic equation is 

R 

~ J s 3 + (K„ + K K ) S 2 + K (nK + K K T ) s + nK K K T = 0 (A-4) 

K t B a v a' e v I a e I 

i 

For the gains used previously and introducing R^ as the nominal motor 
resistance this becomes 


R 


^ s 3 + 203. 7 s 2 + 11, 787 s + 100, 625 = 0 


M 


(A- 5) 


As indicated in (85) and (86) the gains here allow the system to be considered 
second order (to get the complex roots). 


R 


R 


s 2 + 203. 7 s + 11, 787 = 0 
M 


(A-6) 


Introducing and as the nominal damping and natural frequency = 1) 


R 


R 


M 2 * 1 , *2 _ 

— s + 2 u w s + w =0 

i n n 

M 


(A- 7 ) 
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Thus, the altered values, £ and oo n are 


oo_ - 


R 


, \ 1/2 

M 


n \ R 


M 


to. 


n 


£ = 


(A- 8 ) 


R 


T/2 


M 


R 


M , 


The slight increase in oo for the computed torque system from (A-3), rather 

than a decrease, is due to the lower gains which result in a system which cannot 

be considered second order as above. But if R^. were increased by a larger 

factor, oo would decrease even for that case, 
n 

With stability evidently not a serious problem the next area to investigate 
is transient response and steady state errors. 

Driving Input Response 

The transfer function is 


6 o (s) 

e.(s) 


S 3 + K S 2 + K s + K t 
v el 


R 


~ s 3 + K s 2 + K s + K, 


(A-9) 


R 


v 


M 


No attempt is made here to investigate transient response errors, since 
the inversion of Eq. (A-9) is very difficult for any analytic input function. 
Furthermore, the ratio R^/R^ I s -1*2 which is very likely negligible. 

Disturbance Torque 

The transfer function is 


T do (s) 


57. 3 n s 


t 


i 


i 


T 3 , T 1 R M t , 2 , T ! R M t , , T « R M t , 

J s + J — K s + J -= — K s + J — K t 

R-» ^ v R^ , e R. , I 


M 


M 


M 


(A- 1 0) 
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0 


0 o (t) = 

t — CO 


But for K, 


2 

n t 


0 (t) = 57. 3 

o 


do 


J K 


R 


R 


M 


M 


(A- 11) 


With increased R.^, the steady state error increases proportionately. 

Position Feedback Null Error 

The transient response is altered slightly but the steady state error is 
unaltered from Eqs. (21) and (23) regardless of the value of and change in 

R M‘ 

Rate Feedback Error 

The transient response is altered slightly but the steady state error is 
unaltered from Eqs. (28) and (30) regardless of change in R^. 

If a current drive is used a slight change in the system occurs. The 
loop transfer function, G(9) in figure 3 is eliminated because the input is 

I 

current, not voltage. The voltage-torque characteristic represented by R^./K^, 
now becomes 1/K^, which is oz-in/amp. This means the characteristic, 
obtained from lab tests, relates current rather than voltage to torque. Con- 
sequently, the motor speed does not have to be monitored during the test 
because the back e.m. f. does not have to be computed and subtracted from 
the applied voltage to get the motor voltage ( V^. ) . 
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APPENDIX B 


EFFECT OF MANIPULATING A LARGE INERTIA OBJECT 


It has been shown that a change in system inertia has no effect on the 
system response (for the CT system), because this change in inertia is con- 
tinuously computed and is used in the feedback loops to multiply the gains. 

This is a very desirable situation, but Stanford experience has shown that, if 
this gain becomes very high, the noise amplification becomes a problem and 
the system tends to become unstable. Joints (links) 4 and 5 are mostly affected 
because they experience a very large inertia change when a large inertia object 
is being manipulated. This assumes that the inertia of the object is known or 
is determined by the system prior to manipulation. 

We are considering two problems here: (1) the noise problem with high 
inertia and therefore high gain, (2) the change in system response with an 
incorrect inertia due to an unknown object inertia. 

The system characteristic equation is 

i i i 

s 2 +~K s 2 +^-K s + ?=- K t = 0 (B-2) 

J v J e J I 


Therefore, multiplying the gains K , K and K by the computed inertia, 
i . v e i 

J assures a system with uniform response. As the inertia changes the stability 
margin should theoretically remain the same. But if it seems desirable to 
reduce the response (and keep the damping constant at 1), a number of ways 
are available. One method is to not multiply K as before by J and to divide 

I ® | 

Kj. by J rather than multiplying. Assuming that J = J this results in 


3 

s 


t 


J K 




K, 


s + ■ 


JJ 


0 


(B-3) 
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Assuming a second order system and £, = 1, 


co = (K /J) 
n e 


1/2 


(B-4) 


Thus, as J increases, co will decrease. But first, a desired or nominal 

7 M 


n 


frequency to has to be selected, which corresponds to some nominal inertia, 


n 


J . The gains can then be computed (for L, = 1 ) 


ii n 

K = 2co 
v n 


(B-5) 


and 


ii ii? 
ii J K 

V 

K = ~c— 

e 4 


(B-6) 


Now, as J changes, K e is constant but has to be recomputed each cycle to 
keep £ = 1. 


K = 2 (k"/j) 

v \ e / 


1/2 


(B — 7) 


The system natural frequency is 


1/2 


co = 

n 


co 


n 


(B-8) 


The result is a decrease in and the ratio of the rate error loop gain to 
nominal is 


J K 


v 
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The result of this gain procedure is that the above gain increases by the 
square root of the inertia change ratio rather than directly as before. The 
response is slower but the noise is not amplified as much. It is quite possible 
that this method which involves recomputing the gain each cycle may not be 
necessary with tachometers on links 4 and 5 because the noise is much less 
than if rate data is computed from position feedback data. 

The above makes no mention of K^, but its value is dependent on the other 
gains. From (47) the maximum value for is 

K T < K K 
I v e 


In this case it is 


K K K 

-4 < — V- or K < J K K (B-10) 

j2 J I v e 

n 

Therefore if J increases from the nominal J its value can theoretically increase. 
Its nominal value at j" is some fraction of (B-10). 

The second problem being discussed here is the possibility of not knowing 
the inertia of an object to be manipulated, and its effect on system performance. 

For the gain method used in the body of this report (w n and f, independent 
of a change in J), the transfer function, for an input function from the planning 
program, is 


e o (s) 

e 2 ( S ) 


s^ + K s 2 + K s + K t 

v e I 

JR M 3 , 2 , T , 

— s + K s +K s+K t 

• - * v e I 


J R 


M 


(B- 1 1) 


This is to show that an unknown change in motor resistance (R^) can be lumped 
with a change in inertia (J). But the much greater change in J when an object 
is manipulated makes the small 20% change in R^. negligible. Therefore only 
J will be used in this discussion. 
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The natural frequency and damping, assuming the gains are such that 
the system can be considered second order, are 



(B- 12) 


where the primed values are the computed and assumed values, whereas the 
unprimed are the actual values of the parameters. 

For the gain computation method discussed previously in this appendix 
the parameters are 


u = (K /J) 1/2 = w ' 
n e n 


(B-13) 


£ 



, 1/2 


(JK 



As shown in (B-13) the damping ratio decreases directly with increase in 
J. Thus, this method of computing gains may accomplish its purpose if J 
is always known, but if not, the first method as shown in (B-12) does not result 
in as large a decrease in t,. Obviously, other method’s are easily incorporated, 
but they will not be discussed here. 
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TEST FOR MAXIMUM MOTOR VOLTAGE 

The JPL procedure at present is to use only third degree polynomials 
to fit the desired trajectory in the planning program. The polynomials are: 

2 3 

9.(t) = a„ + a.t + a 0 t + a-t 
1 0 1 2 3 

0^(t) = a^ + 2a^t + 3a^t 2 (C-l) 

0.(t) = 2a 0 + 6a-.t 
l 2 3 

There is some concern that the applied motor voltage necessary to generate 
the above functions may exceed the allowable maximum. This appendix is a 
very brief discussion of one method of checking this possibility. 

The applied voltage is 


V 

a 


E + i 


M 


R 


M 


R 

= K_ 0, . + T Tf 
B M M K 


M 


(C - 2) 


Since 


M 


— 0 . , and t 
n l M 


= J 9 


M 


K R R., 

V = — 0. + J 0. 
a n i nK_ i 


(C-3) 


Substituting from (C-l) 


V 


= n { K B^ a l + 2a 2 t + 3a 3 t2 ) + J (2a 2 + 6a 3 fc) 


(C-4) 
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Taking the derivative and setting it equal to zero, and solving for t results 
in 



Now, compute V from (C-4) using t from (C-5). If its value is larger than 

2L 

a given maximum, the trajectory is undesirable because the motor torque 
will not be as large as required to follow the trajectory in (C-l). Of course, 
the error signals will eventually bring the error to zero, but the resultant 

t 

deviation before this may be undesirable. In any respect, depending on the 
error signals for large errors defeats the purpose of the computed torque sys- 
tem, and the operation is then much like a conventional position servo. 
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LIST OF SYMBOLS 


J L 

J' 

J 




M 


K, 

K 

< 

K ] 

K 

n 

R 

K 


B 


M 


T 

VS 

G 

g 


M 


V 


M 


e . 

1 


M 


Computed inertia of load (not including motor) referred to output 

Actual inertia of load (not including motor) referred to output 

Total computed inertia referred to motor shaft 

Total actual inertia referred to motor shaft 

Total computed inertia referred to output 

Motor inertia referred to motor shaft 

Rate error feedback gain 

Position error feedback gain 

Integral of position error feedback gain 

Motor back e.m.f. constant 

Gear speed reduction ratio (motor to output) 

Resistance of motor input winding 

Motor current - torque constant 

Motor voltage - torque constant (characteristic) 

Program for computing the gravitational torques 

Computed torque from the integral gain feedback 

Actual gravitational torque 

Computed input driving function torque 

Motor voltage for driving torque and error torque 

Total applied motor voltage including back e.m.f. 

Motor shaft output angle 

Input angle from planning program 

Output angle 

Laplace operator 

Motor back e. m. f. 

Motor input current 
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t,. Motor torque 

M 

A8^ Bias error in position feedback signal 

A0* , Bias error in rate feedback signal 

M e 

t Disturbance torque referred to output 

T dM Disturbance torque referred to motor 

At Computation cycle time 

f, Damping ratio 

oj Undamped natural frequency 

K Amplifier gain of conventional position servo 

ct 

jw Complex frequency 


0p Peak angular excursion of a sinusoidal input 

A0 q Output angular error for sinusoidal input 
A0 q ^ Peak output error for sinusoidal input 
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